import lejos.nxt.Button;
import MULE.Bewegungsmodul.Engine;
import MULE.Bewegungsmodul.MotionController;
import MULE.Bewegungsmodul.util.EngineParameter;
import MULE.Sensorenmodul.Light;
import MULE.Sensorenmodul.util.SensorParameter;


public class TESTMController {

	public EngineParameter params = new EngineParameter(360, 12.55, 5.6, 1/48, 'A', 'B');
	public SensorParameter params2 = new SensorParameter(1,2);
	public Engine getriebe = new Engine(params);
	public Light sensor = new Light(params2);
	public MotionController motion = new MotionController(params, getriebe, sensor);
	
	public static void main(String[] args) {
		TESTMController test = new TESTMController();
		
		System.out.println("Running forward");
		Button.waitForPress();
		
		test.motion.moveDistance(0.5, 0, 10);
			
		System.out.println("stop running");
		Button.waitForPress();
	}

}
